#include "board.h"
#include "MotorControl.h"


int32_t g_arrs32D3Pos[4];


void demo_Enc(void) {
    Enc_Init();
    
    while(1) {
        Enc_Update(&hstEnc_1);
        Enc_Update(&hstEnc_2);
        Enc_Update(&hstEnc_3);
        Enc_Update(&hstEnc_4);
        
        int32_t _temp = 0;
        Enc_GetPosD3(&hstEnc_1, &_temp);
        g_arrs32D3Pos[0] = _temp;
        Enc_GetPosD3(&hstEnc_2, &_temp);
        g_arrs32D3Pos[1] = _temp;
        Enc_GetPosD3(&hstEnc_3, &_temp);
        g_arrs32D3Pos[2] = _temp;
        Enc_GetPosD3(&hstEnc_4, &_temp);
        g_arrs32D3Pos[3] = _temp;
    }
}
